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Abstract — In this paper, we present a general theory of motion VI Appendix 
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planning for kinematic systems. This theory has been developed 
for long by one of the authors in a previous series of papers. 
It is mostly based upon concepts from subriemannian geometry. 
Here, we summarize the results of the theory, and we improve 
on, by developping in details an intricated case: the ball with 
a trailer, which corresponds to a distribution with flag of type 
2,3,5,6. 

This paper is dedicated to Bernard Bonnard for his 60"' 
birthday. 

Index Terms — Optimal control, Subriemannian geometry, 
robotics, motion planning 
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I. Introduction 



Here we present the main lines of a theory of motion 
planning for kinematic systems, which is developped for about 
ten years in the papers i), M, IM, lEl, M, US, Gl- 
One of the purposes of the paper is to survey the whole theory 
disseminated in these papers. But also we improve on the 
theory, by treating one more case, in which "the fourth order 
brackets are involved". We aslo improve on several previous 
results (periodicity of our optimal trajectories for instance). 
Potential application of this theory is motion planning for 
kinematic robots. We will show several basic examples here. 

The theory starts from the seminal work of F. Jean, in the 
papers |[T6l . ilTTl . lITSl . At the root of this point of view in 
robotics, there are also more applied authors Uke J. P. Laumond 
EOl . See also El- 

We consider kinematic systems that are given under the 
guise of a vector-distribution A over a n-dimensional manifold 
M. The rank of the distribution is p, and the corank k — 
n—p. Motion planning problems will aways be local problems 
in an open neighborhood of a given finite path T in M. Then 
we may always consider that M = W\ From a control point 
of view, a kinematic system can be specified by a control 
system, linear in the controls, typically denoted by S: 



(S) 



E^»( 



X)Ui, 



(1) 



i=l 



where the F^'s are smooth (C°°) vector fields that span 
the distribution A. The standard controllability assumption is 
always assumed, i.e. the Lie algebra generated by the F^'s is 
transitive on M. Consequently, the distribution A is completely 
nonintegrable, and any smooth path F : [0, T] — > M can be 
unifomly approximated by an admissible path 7 : [0, 0] — > M, 
i.e. a Lipschitz path, which is almost everywhere tangent to 
A, i.e., a trajectory of ([T]i. 

This is precisely the abstract answer to the kinematic mo- 
tion planning probem: it is possible to approximate uniformly 
nonadmissible paths by admissible ones. The purpose of this 
paper is to present a general constructive theory that solves 
OffihS priiiteBEin a certain optimal way. 



More precisely, in this class of problems, it is natural to try 
to minimize a cost of the following form: 



J{u) 



l\ 



J2M'dt, 



1=1 



for several reasons: 1. the optimal curves do not depend 
on their parametrization, 2. the minimization of such a cost 
produces a metric space (the associated distance is called the 
subriemannian distance, or the Carnot-Caratheodory distance), 
3. Minimizing such a cost is equivalent to minimize the 
following (called the energy of the path) quadratic cost Je{u), 
in fixed time 9: 



Je{u)= /^( 



'dt. 



4=1 



The distance is defined as the minimum length of admissible 
curves connecting two points, and the length of the admissible 
curve corresponding to the control u : [0, 9] -^ M is just J{u). 

In this presentation, another way to interpret the problem 
is as follows: the dynamics is specified by the distribution A 
(i.e. not by the vector fields Fi, but their span only). The cost 
is then determined by an Euclidean metric g over A, specified 
here by the fact that the F^'s form an orthonormal frame field 
for the metric. 

At this point we would like to make a more or less 
philosophical comment: there is, in the world of nonlinear 
control theory, a permanent twofold critic against the optimal 
control approach: 1. the choice of the cost to be minimized 
is in general rather arbitrary, and 2. optimal control solutions 
may be non robust. 

Some remarkable conclusions of our theory show the 
following: in reasonable dimensions and codimensions, the 
optimal trajectories are extremely robust, and in particular, do 
not depend at all (modulo certain natural transformations) on 
the choice of the metric, but on the distribution A only. Even 
stronger: they depend only on the nilpotent approximation 
along r (a concept that will be defined later on, which 
is a good local approximation of the problem). For a lot 
of low values of the rank p and corank fc, these nilpotent 
approximations have no parameter (hence they are in a sense 
universal). The asymptotic optimal sysntheses (i.e. the phase 
portraits of the admissible trajectories that approximate up to 
a small e) are also universal. 

Given a motion planning problem, specified by a (non- 
admissible) curve r, and a Subriemannian structure ([T]i, we 
will consider two distinct concepts, namely: 1. The metric 
complexity MC{e) that measures asymptotically the length of 
the best e-approximating admissible trajectories, and 2. The 
interpolation entropy E{e), that measures the length of the 
best admissible curves that interpolate F with pieces of length 
e. 

The first concept was introduced by F. Jean in his basic 
paper |i6|. The second concept is closely related with the 
entropy of F Jean in ITTll . which is more or less the same 
as the Koknogorov's entropy of the path F, for the metric 



structure induced by the Carnot-Caratheodory metric of the 
ambient space. 

Also, along the paper, we will deal with generic problems 
only (but generic in the global sense, i.e. stable singularities 
are considered). That is, the set of motion planning problems 
on M" is the set of couples (F, E), embedded with the 
C°° topology of uniform convergence over compact sets, and 
generic problems (or problems in general position) form an 
open-dense set in this topology. For instance, it means that the 
curve r is always tranversal to A (except maybe at isolated 
points, in the cases k — I only). Another example is the 
case of a surface of degeneracy of the Lie bracket distribution 
[A, A] in the n = 3, fc = 1 case. Generically, this surface (the 
Martinet surface) is smooth, and F intersects it transversally 
at a finite number of points only. 

Also, along the paper, we will illustrate our results with one 
of the following well known academic examples: 

Example 1: the unicycle: 



~ coii[9)ui, y = shi(9)ui, 9 = U2 



(2) 



Example 2: the car with a trailer: 



X — cos(0)wi, y — sn\{6)ui, 6 = U2, (p = ui — siii{ip)u2 

(3) 



R, (4) 



where {x, y) are the coordinates of the contact point between 
the ball and the plane, R e 50(3, M) is the right orthogonal 
matrix representing an othonormal frame attached to the ball. 
Example 4: the ball with a trailer 


i = ui, y ~ u2, R= U2 R, (5) 



Example 3: the ball rolling 


on a plane: 









Ml 


X — ui, y = u2, R = 





U2 




— Ml —1*2 












Ui 








U2 


-Ul 


-U2 






9 = --{cos{9)ui + sm{9)u2). 
1^ 

Typical motion planning problems are: 1. for example (J2|i, 

the parking problem: the non admissible curve F is s — > 

{x{s),y{s),9{s),ip{s)) = (s,0, f,0), 2. for example ([3|, the 

full rolling with slipping problem, F : s — ^ {x{s),y{s),R{s)) 

= {s,0,ld), where Id is the identity matrix. On figures [T] 

l2]we show our approximating trajectories for both problems, 

that are in a sense universal. In figure [T] of course, the x-scale 

is much larger than the y-scale. 



Up to now, our theory covers the following cases: 

(CI) The distribution A is one-step bracket generating (i.e. 
dim([A, A] = n) except maybe at generic singularities, 

(C2) The number of controls (the dimension of A) is p = 2, 
and n < 6. 

The paper is organized as follows: In the next section III] 
we introduce the basic concepts, namely the metric complexity, 



Fig. 1. Parking of the car with a trailer 




Fig. 2. Approximating rolling with slipping 



the interpolation entropy, the nilpotent approximation along F, 
and the normal coordinates, that will be our basic tools. 
Section 



III 



summarizes the main results of our theory, 
disseminated in our previous papers, with some complements 
and details. Section IV is the detailed study of the case n — Q, 
fc = 4, which corresponds in particular to example p] the 
ball with a trailer. In Section |V] we state a certain number of 
remarks, expectations and conclusions. 

II. Basic concepts 

In this section, we fix a generic motion planning problem 
V =(r, E). Also, along the paper there is a small parameter 
£ (we want to approximate up to e), and certain quantities 
f{e),g{e) go to +oo when e tends to zero. We say that such 
quantities are equivalent (/ ~ g) if lime_>.o ^H = 1. Also, 
d denotes the subriemannian distance, and we consider the 
£-subriemammian tube Te and cylinder Ce around F : 

T,^{x£M\ d{x,T) < e}, 
C^ = {xe M \ d{x,T) =e}. 



endpoints F(0), F(r) of F, and remaining in the tube T^. 

Definition 6: The interpolation entropy E{e) of P is - 
times the minimum length of an admissible curve 7^ con- 
necting the endpoints F(0), r(T) of F, and e-interpolating F, 
that is, in any segment of 7^ of length > e, there is a point 
of F. 

These quantities AIC{e),E{e) are functions of e which 
tends to +00 as e tends to zero. They are considered up 
to equivalence. The reason to divide by e is that the second 
quantity counts the number of e-balls to cover F, or the number 
of pieces of length e to interpolate the full path. This is also 
the reason for the name "entropy". 

Definition 7: An asymptotic optimal synthesis is a one- 
parameter family 7^ of admissible curves, that realizes the 
metric complexity or the entropy. 

Our main purpose in the paper is twofold: 

1. We want to estimate the metric complexity and the 
entropy, in terms of certain invariants of the problem. Actually, 
in all the cases treated in this paper, we will give eplicit 
formulas. 

2. We shall exhibit explicit asymptotic optimal syntheses 
realizing the metric complexity or/and the entropy. 



B. Normal coordinates 

Take a parametrized p-dimensional surface S, transversal 
to A (maybe defined in a neighborhood of F only), 

S = {q{si,...,Sp-i,t) eK"},with q{0,...,Q,t) =T{t). 

Such a germ exists if F is not tangent to A. The exclusion of 
a neighborhood of an isolated point where F is tangent to A, 
(that is F becomes "almost admissible"), will not affect our 
estimates presented later on (it will provide a term of higher 
order in e). . 

In the following, Cf will denote the cylinder {^; d{S, ^) = 
e}. 

Lemma 8: (Normal coordinates with respect to S). There 



are mappmgs x 



y ■ 



pk-1 



w 



K, such that ^ = {x,y,w) is a coordinate system on some 
neighborhood of S in M", such that: 

0. S{y,w) = {0,y,w), T ^ mO^w)} 

1. The restriction A|5 = keidw r\i=i,,,k-i kei dyi, the 
metric g^s = J2LMxi)'^ , 

3. geodesies of the Pontryagin's maximum principle (f2ll) 
meeting the transversality conditions w.rt. S are the straight 
lines through S, contained in the planes Pyo.wo = {(.liVi^) = 
(yoiWo)}. Hence, they are orthogonal to 5*. 

These normal coordinates are unique up to changes of 
coordinates of the form 



A. Entropy versus metric complexity x = T{y, w)x, (y, w) — (y, w), 

Definition 5: The metric complexity MC{e) of P is - times 
the minimum length of an admissible curve 7^ connecting the where T{y, w) £ 0{p), the p-orthogonal group. 



(6) 



C. Normal forms, Nilpotent approximation along T 

1) Frames: Let us denote by F = (Fi, ..., Fp) the orthonor- 
mal frame of vector fields generating A. Hence, we will also 
write V — (F, F). If a global coordinate system {x, y, w), not 
necessarily normal, is given on a neighborhood of F in M", 



with X E 



Ki", ye 
p 

E2^ 



pfe-1 



for some fc > 0. 

At this point, we shall split the problems under considera- 
tion into two distinct cases: first the 2-step bracket-generating 
case, and second, the 2-control case. 

3) Two-step bracket-generating case: In that case, we set. 



w € 



then we write: 

fc-i 



iix,y,w) 



dxi 



^Aj(x,j/,u;)— - (7) 



i=l 



^y^ 



Mj{x,y,w) 
= l,...,p. 






in accordance to Proposition 11 that x has weight 1, and the 
yi's and w have weight 2. Then, the vector fields g|- have 

weight -1, and J^, -§- have weight —2. 

'^ oyt ' ow * 

Inside a tube T^, we write our control system as a term of 
order -1, plus a residue, that has a certain order w.r.t. e. Here, 
0{£^) means a smooth term bounded by ce'^ . We have, for a 
trajectory remaining inside T^: 



X = M + 0(£^); 



(1) 



(8) 



y^ ^ -x'V{w)u + 0{s'^); i ^ 1, ...,k - 1; 
w = -x'M{w)u + 0{e'^), 



where U{'w),M{w) are skew-symmetric matrices depend- 
ing smoothly on w. 

Remark 12: In^ (1), the term 0(£^) can seem surprising 



One should wait for 0{e). It is due to (1) in Proposition 10 
In that case, we define the Nilpotent Approximation P 
along F of the problem V by keeping only the term of order 
-1: 



iV) 



x — u\ 
1 

1 



(9) 



x'V{w)u; i~l,...,p—l; 



Hence, the SR metric is specified by the triple {Q,£,M) of 
smooth X, y, w-dependent matrices. 

2) The general normal form: Fix a surface S as in Section 
?? and a normal coordinate system ^ = (x, y, w) for a problem 

r. 

Theorem 9: (Normal form, |2|) There is a unique orthonor- 
mal frame F = {Q,C,A4) for iA,g) with the following 
properties: 

1. Q{x,y,w) is symmetric, Q{0,y,w) — Id (the identity 
matrix), 

2. Q{x,y,w)x == X, 

3. C{x, y, w)x — 0, A4{x, y, w)x ~ 0. 

4. Conversely if ^ = {x, y, w) is a coordinate system satis- 
fying conditions 1, 2, 3 above, then ^ is a normal coordinate 
system for the SR metric defined by the orthonormal frame F 
with respect to the parametrized surface {{0,y,w)}. 

Clearly, this normal form is invariant under the changes of 
normal coordinates (|5|l. 
Let us write: 

Q{x,y,w) = Id + Qi{x,y,w) +Q2{x,y,w) + ..., 
C{x,y,w) = + Li{x,y,w) + L2{x,y,w) + ..., 
M{x,y,w) = + Mi{x,y,w) + M2{x,y,w) + ..., 

where Qr,Lr, Mr are matrices depending on i^ = {x, y, w), 
the coefficients of which have order k w.r.t. x (i.e. they 
are in the r*'' power of the ideal of C°°{x,y,w) gener- 
ated by the functions Xr, r = 1 , . . . , n — p) . In particu- 
lar, Qi is linear in x, Q2 is quadratic, etc... Set u — 
(ui,...,Up) G W. Then Y^jZi Li^ix,y,w)u.j = Li,,y_^„(x,u) 
is quadratic in {x,u), and M*^"^ -valued. Its i*'' component is 
the quadratic expression denoted by Li^i^y^^{x,u). Similarly 

H'^jZl Mi^i^, y,w)uj = Mi^y^^{x,u) is a quadratic form in \\x{t)-x{t)\\ < ce^, \\y{t)-y{t)\\ < c£^ \\w{t)~w{t)\\ < ce^ 

(10) 
for a suitable constant c. 

Remark 13: It follows that the distance (either d or d-the 
distance associated with the nilpotent approximation) between 
£,{t),£,{t) is smaller than e^+" for some a > 0. 

This fact comes from the estimate just given, and the 
standard ball-box Theorem (fTSl). It will be the key point to 
reduce the motion planning problem to the one of its nilpotent 
approximation along F. 
4) The 2-control case: 



ti) — -x'M{w)u. 



Consider two trajectories £,{t),£,{t) of P and V correspond- 
ing to the same control u{t), issued from the same point on 
F, and both arclength -parametrized (which is equivalent to 
||w(t)|| — 1). For t < e, we have the following estimates: 



{x,u). The corresponding matrices are denoted by Li^t,y,w, 
i = 1, ...,fc — 1, and Mi^y^^. 

The following was proved in [|2l, Q for corank 1: 

Proposition 10: 1. Qi = 0, 

2- Li,i,y,w, i = Ij •■•iP—lj and Af 1 ,y ^, are skew symmetric 
matrices. 

A first useful very rough estimate in normal coordinates is 
the following: 

Proposition 11: If ^ = {x,y,w) G T^, then: 

Ikll2<£, 

Il^/ll2<fc£^ 



5) Normal forms: In that case, we have the following 
general normal form, in normal coordinates. It was proven 
first in [1], in the corankl case. The proof holds in any corank, 
without modification. 

Consider Normal coordinates with respect to any surface S. 
There are smooth functions, /3{x, y, w),ji{x, y, w),6{x, y, w), 
such that V can be written as (on a neighborhood of F): 



Xi = {1 + {X2)'^(3)ui- XiX2(3u2, (11) 

±2 = (1 + {Xi)'^(3)u2 - XiX2(3ui, 

,X2 Xi^ , . r/*^2 -^1 \ 

yj =7»(yWi- y"2), w = (5(yui- yMa), 

where moreover /3 vanishes on the surface S. 

The following normal forms can be obtained, on the tube 
Te, by just changing coordinates in S in certain appropriate 
way. It means that a trajectory (,{t) of V remaining in T^ 
satisfies: 

Generic 4 — 2 case (see lHH): 

ii = ui + O(e^), ±2 = U2 + O(e^), 
y = i^u,-^u2) + Ois% 

w = J(w)a;i( ywi - Y"2) + 0{e^). 
We define the nilpotent approximation as: 

{y4.2) Xi=Ui,X2^U2,y ={—-Ui~ —U2), 

w = b[w)xi{ — ui - -^U2). 

Again, we consider two trajectories C(^)jC(0 of V and 
V corresponding to the same control u{t), issued from the 
same point on F, and both arclength-parametrized (which is 
equivalent to ||u(i)|| = 1). For t < e, we have the following 
estimates: 



\\x{t)-x{t)\\ < c£^ Mt)-ym < ceM\w{t)-wit)\\ < ce\ 

(12) 

Which implies that, for t < e, the distance (d or d) between 
^(t) and ^(t) is less than e^+" for some a > 0, and this will 
be also the keypoint to reduce our problem to the Nilpotent 
approximation. 

Generic 5 — 2 case (see lll3l ): 

xi=ui+ O(e^), ±2 = U2 + 0{e^), 
--u2) + 0{e^), 



,X2 

2^ = (y"i 2 



Z = X2\—Uy - Y"2) + <-'(^ )' 

w = 5(u;)xi(yui - YU2) + O(e^). 



We define the nilpotent approximation as: 

'- Xo 

(^5,2) ii =ui,x2 = u2,y = {—ui 

,X2 Xx 

Z = X2{ — Ui- yW2), 

w = 5{w)xi{ — ui - -7^U2). 



Xi 



-U2) 



The estimates necessary to reduce to Nilpotent approxima- 
tion are: 

\\x{t) - xm < ce\ \\y{t) - y{t)\\ < ce\ (13) 

Mt) - z{t)\\ < ce^ \\w{t) - w{t)\\ < cs\ 

Generic 6 — 2 case (proven in Appendix): 

xi=ui+0{e^),X2^u2 + 0{e^), (14) 



,X2 



Xi 



2) = (f«i-y^2) + 0(e^), 



zi 



,X2 



Xl 



X2i^U,-^U2)+Ois% 



2 2 

,X2 Xl 



Z2 = xii—ui - -^^2) + O(e^), 

w = Qw{xi,X2){y'^i - Y"2) + 0{e'^), 

where Qw{xi,X2) is a quadratic form in x depending 
smoothly on w. 



We define the nilpotent approximation as: 

[P6,2) xi^ui,x2=u2,y ^ ( — ^1- Y 



■"2), 



(15) 



zi = a;2( Y^i ~ y"2)' ^2 = a;i(yui - y'^^)' 

W = Qw{xi,X2){—Ui - yU2)- 

The estimates necessary to reduce to Nilpotent approxima- 
tion are: 

\\x{t) - x{t)\\ < ce\ \\y{t) - y{t)\\ < ce\ (16) 

Mt) - z{t)\\ < C£^ \\w{t) - w{t)\\ < C£^ 

In fact, the proof given in Appendix, of the reduction to this 
normal form, contains the other cases 4-2 and 5-2. 

6) Invariants in the 6-2 case, and the ball with a trailer: 

Let us consider a one form w that vanishes on A" = 

[A. [A, A]]. Set a ~ di^|Ai the restriction of do; to A. Set 
H = [Fi,F2], I = [Fl,H], J = [F2,H], and consider the 
■ duj{Fi,I) dw{F2,I) ■ 
duj{Fi,J) diu{F2,J) 

Due tu Jacobi Identity, v4(^) is a symmetric matrix. It is 
• w([Fi,/]) uj{[F2,I]) ' 
uj{[Fi,J]) u:{[F2,J]) 
uj{[X,Y]) = duj{X,Y) in restriction to A" 

Let us consider a gauge transformation, i.e. a feedback 
that preserves the metric (i.e. a change of othonormal frame 
(Fi,F2) obtained by setting A = cos{e{C))Fi+siii{9{^))F2 , 
F2 = - sin(0(O)Fi + cos(0(O)F2 ). 

It is just a matter of tedious computations to check that 
the matrix A{£,) is changed for A{^) = RoA{£^)R_g. On the 
other hand, the form oj is defined modulo muttiplication by 
a nonzero function /{£,), and the same holds for a, since 
d{fuj) = fdoj+dfAcd, and uj vanishes over A". The following 
lemma follows: 

Lemma 14: The ratio r(f ) of the (real) eigenvalues of A{S) 
is an invariant of the structure. 



2x2 matrix A{Cj 



also equal to 



, using the fact that 



Let us now consider the normal form (14 1, and compute 
the form lu — ujidxi + ... + uj^dw along F (that is, where 
x^y^z — Q). Computing all the brackets show that uji = ixi2 = 



... = ws =0. This shows also that in fact, along T, A{(_) is just 
the matrix of the quadratic form Q^. We get the following: 

Lemma 15: The invariant 7'(r(f)) of the problem V is the 
same as the invariant f{T{t)) of the nilpotent approximation 
along r. 

Let us compute the ratio r for the ball with a trailer, 
Equation (J5]l. We denote by Ai,A2 the two right-invariant 
vector fields over S'o(3,M) appearing in (J5]l. We have: 



^1 = 7^ + ^1 
ox I 



F, 



Ao 



d 
dx2 



= -A2,[A2,A3] ^Ai. 



Then, we compute the brackets: H 






I = -A2_^sin(0)j|, J = A,+ ^cos{e)§-„ [Fi,/] = 



-Ao 



1 d 



3-pr 



, [Fi,J] = = [F2,/], [F2,J] 



'A. 



1 a 



3-L4 de- 



Then: 

Lemma 16: For the ball with a trailer, the ratio r(^) ~ 1. 

These two last lemmas are a key point in the section IIV] 
theyl imply in particular that the system of geodesies of the 
nilpotent approximation is integrable in Liouville sense, as we 
shall see. 

III. Results 

In this section, we summarize and comment most of the 
results obtained in the papers ISl. Il9ll. ifTOl. ifTH. lfT3l. lfT4l. 

A. General results 

We need the concept of an e-modification of an asymptotic 
optimal synthesis. 

Definition 17: Given a one parameter family of (absolutely 
continuous, arclength parametrized) admissible curves 7^ : 
[0, T-y^] — >■ K", an e-modification of 7^ is another one param- 
eter family of (absolutely continuous, arclength parametrized) 
admissible curves 7^ : [0, T^^ — >■ M" such that for all e and for 
some a > 0, if [0,T.yJ is splitted into subintervals of length 
e, [0,e], [e,2e], [2e,3e],... then: 

1. [0,r;y^] is splitted into corresponding intervals, [0,ei], 
[£i,ei+e2], [ei+£2,£i+ff2+e3], ••• with e < e^ < £(l + e"), 

2 = 1,2,..., 

2. for each couple of an interval I\ — [e^ , e^ + e] , (with 
£0 = 0, ei = £1, £2 = £1 + £2, ■•■) and the respective interval 
h = [»e, (i + 1)£], ^(7) and ^(7) coincide over h, i.e.: 

— (7)(£,; + t) = — (7)(i£ + t), for almost all t e fO,e]. 
at at 

Remark 18: This concept of an e-modification is for the 
following use: we will construct asymptotic optimal syntheses 
for the nilpotent approximation V of problem V. Then, the 
asymptotic optimal syntheses have to be slightly modified in 
order to realize the interpolation constraints for the original 
(non-modified) problem. This has to be done "slightly" for 
the length of paths remaining equivalent. 

In this section it is always assumed but not stated that 
we consider generic problems only. One first result is the 
following: 



Theorem 19: In the cases 2-step bracket generating, 4-2, 5- 
2, 6-2, (without singularities), an asymptotic optimal synthesis 
[relative to the entropy] for V is obtained as an £-modification 
of an asymptotic optimal synthesis for the nilpotent approxi- 
mation V. As a consequence the entropy E{e) of V is equal 
to the entropy E{e) of V. 

This theorem is proven in |[T2l . However, we can easily get 
an idea of the proof, using the estimates of formulas ( 10 12 
fT3lfT6l. 



All these estimates show that, if we apply an e-interpolating 
strategy to V, and the same controls to V, at time e (or 
length e-since it is always possible to consider arclength- 
parametrized trajectories), the enpoints of the two trajectories 
are at subriemannian distance (either d or d) of order e^+", for 
some a > 0. Then the contribution to the entropy of P, due 
to the correction necessary to interpolate F will have higher 
order. 

Also, in the one-step bracket-generating case, we have the 
following equality: 

Theorem 20: (one step bracket-generating case, corank k < 
3) The entropy is equal to 2tt times the metric complexity: 
E{e) = 27rA/C(e). 

The reason for this distinction between corank less or more 
than 3 is very important, and will be explained in the section 

lUFCl 

Another very important result is the following logarithmic 
lemma, that describes what happens in the case of a (generic) 
singularity of A. In the absence of such singularities, as we 
shall see, we shall always have formulas of the following type, 
for the entropy (the same for the metric complexity): 



E( 



=>4 



dt 



(17) 



where x(i) is a certain invariant along F. When the curve 
r{t) crosses tranversally a codimension- 1 singularity (of A', 
or A"), the invariant x(t) vanishes. This may happen at 
isolated points ti, i — l,...r. In that case, we always have 
the following: 

Theorem 21: (logarithmic lemma). The entropy (resp. the 
metric complexity) satisfies: 



E{e 



,M£) 

eP 



1 






■^.PiU)' 



where p{t) 



' dt ' 



On the contrary, there are also generic codimension 1 
singularities where the curve F, at isolated points, becomes 
tangent to A, or A', .•• At these isolated points, the invariant 



x(t) of Formula 17 tends to infinity. In that case, the formula 
[17] remains valid (the integral converges). 

B. Generic distribution in M.^ 

This is the simplest case, and is is important, since many 
cases just reduce to it. Let us describe it in details. 

Generically, the 3-dimensional space M contains a 2- 
dimensional singularity (called the Martinet surface, denoted 
by A^). This singularity is a smooth surface, and (except at 
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Fig. 3. 3-dimensional contact case 



Fig. 4. 3-dimensional Martinet case 



isolated points on A^), the distribution A is not tangent to A4. 
Generically, the curve F crosses A4 transversally at a finite 
number of isolated points ti, i = 1, ...,r, . These points are 
not the special isolated points where A is tangent to M (this 
would be not generic). They are called Martinet points. This 
number r can be zero. Also, there are other isolated points tj , 
j — 1, ...,l, at which F is tangent to A (which means that F 
is almost admissible in a neighborhood of tj). Out of A4, the 
distribution A is a contact distribution (a generic property). 

Let cij be a one-form that vanishes on A and that is 1 
on F, defined up to multiplication by a function which is 1 
along F. Along F, the restriction 2-form duj\A can be made 
into a skew-symmetric endomorphism A{r{t)) of A (skew 
symmetric with respect to the scalar product over A), by 
duality: < A{T{t))X,Y >= dcu{X,Y). Let x{t) denote the 
moduli of the eigenvalues of A{r{t)). We have the following: 

Theorem 22: 1. If r = 0, MC{e) ~ ^ / ;^. At points 



where x(t) — >■ +oo, the formula is convergent. 



2. If r ^ 0, MC{e) 



)ln(£) 



ELi 



p(t>)' 



where p{t) — 



dt 



3. E{e) = 2TiMC{e). 
Let us describe the asymptotic optimal syntheses. They are 
shown on Figures |3] p] 



Figure [3] concerns the case r — Q (everywhere contact type). 
The points where the distribution A is not transversal to F 
are omitted (they again do not change anything). Hence A is 
also transversal to the cylinders C^, for e small. Therefore, 
A defines (up to sign) a vector field X^ on Ce, tangent to 
A, that can be chosen of length 1. The asymptotic optimal 
synthesis consists of: 1. Reaching C^ from F(0), 2. Follow 
a trajectory of X^, 3. Join T{t). The steps 1 and 3 cost 2e, 
which is neglectible w.r.t. the full metric complexity. To get 
the optimal synthesis for the interpolation entropy, one has to 
make the same construction, but starting from a subriemannian 
cylinder C^ tangent to F. 

In normal coordinates, in that case, the x-trajectories are 
just circles, and the corresponding optimal controls are just 
trigonometric functions, with period — . 



Figure |4] concerns the case r 7^ (crossing Martinet 
surface). At a Martinet point, the vector-field X^ has a limit 
cycle, which is not tangent to the distribution. The asymptotic 
optimal strategy consists of: a. following a trajectory of X^ 
till reaching the height of the center of the limit cycle, b. 
crossing the cylinder, with a neglectible cost 2e, c. Following 
a trajectory of the opposite vector field — X^. The strategy for 
entropy is similar, but using the tangent cylinder C^. 



C. The one-step bracket- generating case 

For the corank fc < 3, the situation is very similar to the 
3-dimensional case. It can be competely reduced to it. For 
details, see ifTOll . 

At this point, this strange fact appears: there is the limit 
corank A; = 3. If /c > 3 only, new phenomena appear Let us 
explain now the reason for this 

Let us consider the following mapping S^ : A^ x A^ ^• 
T^M/A^, {X, Y) -^ [X, Y] + Aj. It is a well defined tensor 
mapping , which means that it actually applies to vectors (and 
not to vector fields, as expected from the definition). This is 
due to the following formula, for a one-form w : (iaj(X, Y) = 
uj{[X,Y])+Lu{Y)X -Lu{X)Y. Let us call I^ the image by B^ 
of the product of two unit balls in A^. The following holds: 

Theorem 23: For a generic V, for fc < 3, the sets /p(t) are 
convex. 

This theorem is shown in ifTOl . with the consequences that 
we will state just below. 

This is no more true for fc > 3, the first catastrophic 
case being the case 10-4 (a p = 4 distribution in M^"). The 
intermadiate cases fc = 4, 5 in dimension 10 are interesting, 
since on some open subsets of F, the convexity property may 
hold or not. These cases are studied in the paper |13|. 

The main consequence of this convexity property is that 
everything reduces (out of singularities where the logarithmic 
lemma applies) to the 3-dimensional contact case, as is shown 
in the paper lilOi . We briefly summarize the results. 

Consider the one forms ui that vanish on A and that are 
1 on F, and again, by the duality w.r.t. the metric over 
A, define duj\/^{X,Y) =< AX,Y >, for vector fields 
X, Y in A. Now, we have along F, a (fc — l)-parameter 
affine family of skew symmetric endomorphisms ^r(t) of 



fe-1 



Set xit) 



Ar(t). Say, Ar(,)(A) = A0(,) + ^A,A^(,). 

mf,||Ar(,)(A)|| = Pp(,)(A*(t))||/^' 

Out of isolated points of F (that count for nothing in the 
metric complexity or in the entropy), the f— one parameter 
family ylp(t-)(A*(t)) can be smoothly block-diagonalized (with 
2x2 bloks), using a gauge transformation along F. After 
this gauge transformation, the 2-dimensional eigenspace corre- 
sponding to the largest (in moduli) eigenvalue of ylr(t)(A*(i)), 
corresponds to the two first coordinates in the distribution, and 
to the 2 first controls. In the asymptotic optimal synthesis, all 
other controls are put to zero [here the convexity property is 
used], and the picture of the asymptotic optimal synthesis is 
exactly that of the 3-dimensional contact case. We still have 
the formulas: 
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Fig. 5. The dance of minimum entropy, for 3rd bracket. 



MC{£) 



of Section |II-C5| In both cases, we change the variable 
w for w such that dw — -4^. We look for arclength- 

o{w) c> 

parametrized trajectories of the nilpotent approximation (i.e. 
(ui)^ + (^2)^ = 1), that start from F(0), and reach F in 

/If £ 

— — -, Ji[£) — 2T:MC[e). fixed time e, maximizing / w{T)dT. Abnormal extremals do 



The case fc > 3 was first treated in [1121 in the 10 



dimensional case, and was completed in general in lfT4ll . 

In that case, the situation does not reduce to the 3- 
dimensional contact case: the optimal controls, in the asymp- 
totic optimal synthesis for the nilpotent approximation are 
still trigonometric controls, but with different periods that 
are successive integer multiples of a given basic period. New 
invariants ALJ^ appear, and the formula for the entropy is: 



E{e) 



2n r ^Ujk 



3\2 



the optimal controls being of the form: 



de. 



U2j-lit) 



U2j{t) 






(18) 



'"2r+i(^) = if p is odd . 



3\i 



e{t) 



3 
e(t) 



cos( ), J = !,...,?' 



These last formulas hold in the free case only (i.e. the 



case where the corank k = 



p(p-i) 



the dimension of he 



second homogeneous component of the free Lie-algebra with p 

generators). The non free case is more complicated (see UlAJ ). 

To prove all the results in this section, one has to proceed 

as follows: 1. use the theorem of reduction to nilpotent 



approximation (19 1, and 2. use the Pontriaguin'smaximum 
principle on the normal form of the nilpotent approximation, 
in normal coordinates 



D. The 2-control case, in M and W. 

These cases correspond respectively to the car with a trailer 
(Example l2]i and the ball on a plate (Example l3]l. 

We use also the theorem 19 of reduction to Nilpotent 
approximation, and we consider the normal forms 7^4,2, ^5.2 



no come in the picture, and optimal curves correspond to the 
hamiltonian 

H=^{PF,)^ + {PF2y, 

where P is the adjoint vector. It turns out that, in our normal 
coordinates, the same trajectories are optimal for both the 4-2 
and the 5-2 case (one has just to notice that the solution of the 
4-2 case meets the extra interpolation condition corresponding 
to the 5-2 case). 

Setting as usual ui — cos(i^) — PFi,U2 — sm{ip) — 
PF2, we get ifi = P[Fi,F2],ip = ~P[Fi,[Fi, F2]]PFi - 
P[F2,[Fi,F2]]PF2. 

At this point, we have to notice that only the components 
Pxi , Px2 of the adloint vector P are not constant (the hamil- 
tonian in the nilpotent approximation depends only on the x- 
variables), therefore, P[Fi, [^1,^2]] and P[i^2, [-Fi, -F2]] are 
constant (the third brackets are also constant vector fields). 
Hence, (/3 = acos{(p) + /3sin(</j) — aii + (3x2 for appropriate 
constants a, (3. It follows that, for another constant fc, we 
have, for the optimal curves of the nilpotent approximation, 
in normal coordinates a;i, 0:2 : 

Xi = cos{ip), X2 = sin{(p), 
If = k + Xxi + 1-1X2- 

Remark 24: 1. It means that we are looking for curves in 
the 2:1,2:2 plane, whose curvature is an affine function of the 
position, 

2. In the two-step bracket generating case (contact case), 
otimal curves were circles, i.e. curves of constant curvature, 

3. the conditions of e-interpolation of F say that these curves 
must be periodic (there will be more details on this point in the 
next section), that the area of a loop must be zero (y(e) = 0), 
and finally (in the 5-2 case) that another moment must be zero. 

It is easily seen that such a curve, meeting these interpo- 
lation conditions, must be an elliptic curve of elastica-type. 
The periodicity and vanishing surface requirements imply 
that it is the only periodic elastic curve shown on Figure B] 
parametrized in a certain way. 



The formulas are, in terms of the standard Jacobi elliptic 
functions: 

ui{t) = l-2dn{K{l + — ))2, 

U2{t) = -2dn{K{l + -))sn{K{l + -)) sin(^), 

£ el 



where (^o=i30° (following |22J, p. 403) and ip^ — 130,692° 
following Mathematica® , with k = sin(^) and K(k) is the 
quarter period of the Jacobi elliptic functions. The trajectory 
on the x\^X2 plane, shown on Figure l5] has equations: 

xi(i) = --^[ + 2{Eam{ + K) - Eam{K))l 

4iv £ £ 

, £ AKt 
X2{t) = k—cn{^+K). 

On the figure l2] one can clearly see, at the contact point of 
the ball with the plane, a trajectory which is a "repeated small 
deformation" of this basic trajectory. 

The formula for the entropy is, in both the 4-2 and 5-2 

cases: 

3 f dt 

where cr is a universal constant, a « 0.00580305. 

Details of computations on the 4-2 case can be found in 
lini . and in US for the 5-2 case. 

IV. The ball with a trailer 



We start by using Theorem 19 to reduce to the nilpotent 
approximation along F : 



CPea) ^1 = "i'*2 ^U2,y 



,X2 

(y-i 



Xl 



-U2) 



(19) 



^X2 

zi = a:2(yUi 



— U2),Z2 = Xx{—Ux - —U2) 



w 



i{xi,X2){—Ui 



Xl 



U2)- 



By Lemma [16] we can consider that 

Qw{xi,X2) = 5{w){{xiY + {X2f) 



(20) 



S^ , we can consider 



where 5{'w) is the main invariant. In fact, it is the only 
invariant for the nilpotent approximation along F. Moreover, 
if we reparametrize F by setting dw 
that 5{w) = 1. 

Then, we want to maximaize J wdt in fixed time e, with 
the interpolation conditions: a;(0) = 0,j/(0) = 0, z(0) = 
0, w(0) = 0, x{£) = 0, y{£) = 0, z(e) = 0. 



From Lemma 27 in the appendix, we know that the optimal 



trajectory is smooth and periodic, (of period e). 

Clearly, the optimal trajectory has also to be a length 
minimizer, then we have to consider the usual hamiltonian for 
length: H = \{[P.Fif + [P.F2Y), in which P = (pi, ....pe) 
is the adjoint vector. It is easy to see that the abnormal 
extremals do not come in the picture (cannot be optimal with 
our additional interpollation conditions), and in fact, we will 
show that the hamiltonian system corresponding to the 
hamiltonian H is integrable. 



Remark 25: This integrability property is no more true in 
the general 6-2 case. It holds only for the ball with a trailer. 

As usual, we work in Poincare coordinates, i.e. we consider 
level i of the hamiltonian iJ, and we set: 

ui = PF = sin(iy9), U2 — PG — cos{ip). 

Differentiating twice, we get 

ip ^ P[F, G], (p^ -PFFG.PF - PGFG.PG, 

where FFG = [F, [F, G]] and GFG = [G, [F, G]]. We set 
A = -PFFG, n = -PGFG. We get that: 



(p = \shi{ip) + /icos((/9). 



(21) 



Now, we compute A and fi. We get, with similar notations 
as above for the brackets (we bracket from the left): 



A = PFFFG.PF 
/i = PFGFG.PF 



PGFFG.PG, 
PGGFG.PG, 



and computing the brackets, we see that GFFG = FGFG = 
0. Also, since the hamiltonian does not depend on y, z, w, we 
get that P3,P4,P5,P6 are constants. Computing the brackets 
FFG and GFG , we get that 



, 3 



+ P6XI, ^ 



2^5 



P6X2, 



and then, A 

AA 

P6 



P6 sin((p) and /i — pecosl^ip). Then, by (21 1, 



•^ 



t^, and finally: 

Xl — sm{ip), ±2 == C0s((y9) 



(22) 



-(A 



Setting w 



A = P6sin(^), fi^pQCOs{ip). 
^ (5 = :^, we obtain: 

S = cos{ip), 



JL 

P6 ■ 



W 



V 



sm{ip), 

It means that the plane curve (w(i),(5(t)) has a curvature 
which is a quadratic function of the distance to the origin. 
Then, the optimal curve {xi{t),X2{t)) projected to the hori- 
zontal plane of the normal coordinates has a curvature which is 
a quadratic function of the distance to some point. Following 



the lemma ( 23 1 in the appendix, this system of equations is 
integrable. 

Summarizing all the results, we get the following theorem. 

Theorem 26: (asymptotic optimal synthesis for the ball 
with a trailer) The asymptotic optimal synthesis is an e- 
modification of the one of the nilpotent approximation, which 
has the following properties, in projection to the horizontal 
plane (a;i,X2) in normal coordinates: 

1 . It is a closed smooth periodic curve, whose curvature is a 
quadratic function of the position, and a function of the square 
distance to some point, 

2. The area and the 2'"^ order moments Jj^xi{x2dxi — 
Xidx2) and J^ X2{x2dxi — xidx2) are zero. 
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Fig. 7. Parking the ball with a trailer 



Fig. 6. The dance of minimum entropy for the ball with a trailer 



3. The entropy is given by the formula: E{e) = -^ /p jt^ 



where S{w) is the main invariant from (20i, and ct is a 
universal constant. 

In fact we can go a little bit further to integrate explicitely 

the system (22 1. Set A = cos((y9)A — sin((/3)/i, ft — sin{Lp)X + 
cos((^)/i. we get: 



dX 
lit 
dp, 
'dt 



mK+^{P+fl')), 



2p, 
Pe + \{K + 



1 

2P6 



(X^+f)). 



This is a 2 dimensional (integrable) hamiltonian system. The 
hamiltonian is: 



H^ = -p,X-^^{K 






-n')? 



This hamiltonian system is therefore integrable, and solutions 
can be expressed in terms of hyperelliptic functions. A liitle 
numerics now allows to show, on figure l6j the optimal x- 
trajectory in the horizontal plane of the normal coordinates. 

On the figure [7] we show the motion of the ball with a 
trailer on the plane (motion of the contact point between the 
ball and the plane). Here, the problem is to move along the x- 
axis, keeping constant the frame attached to the ball and the 
angle of the trailer. 



bracket 




Third Bracket 



Second Bracket 
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Fig. 8. The universal movements in normal coordinates 

These figures are, in the two-step bracket generating case: 
a circle, for the third bracket, the periodic elastica, for the 4*'' 
bracket, the plane curve of the figure l6] 

They are periodic plane curves whose curvature is respec- 
tively: a constant, a linear function of of the position, a 
quadratic function of the position. 

This is, as shown on Figure [8] the clear beginning of a 



V. Expectations and conclusions 

Some movies of minimum entropy for the ball rolling on 
a plane and the ball with a trailer are visible on the website 



A. Universality of some pictures in normal coordinates 

Our first conclusion is the following: there are certain 
universal pictures for the motion planning problem, in corank 
less or equal to 3, and in rank 2, with 4 brackets at most (could 
be 5 brackets at a singularity, with the logarithmic lemma). 



B. Robustness 

As one can see, in many cases (2 controls, or corank 
fc < 3) , our strategy is extremely robust in the following sense: 
the asymptotic optimal syntheses do not depend, from the 
qualitative point of view, of the metric chosen. They depend 
only on the number of brackets needed to generate the space. 

C. The practical importance of normal coordinates 

The main practical problem of implementation of our strat- 
egy comes with the e-modifications. How to compute them, 
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how to implement? In fact, the e-modifications count at higher 
order in the entropy. But, if not appHed, they may cause 
deviations that are not neglectible. The high order w.r.t. e in 
the estimates of the error between the original system and 



its nilpotent approximation (Formulas 10 12 13 ??) make 
these deviations very small. It is why the use of our concept 
of a nilpotent approximation along F, based upon normal 
coordinates is very efficient in practice. 

On the other hand, when a correction appears to be needed 
(after a noneglectible deviation), it corresponds to brackets 
of lower order. For example, in the case of the ball with a 
trailer (4*'' bracket), the e-modification corresponds to brackets 
of order 2 or 3. The optimal pictures corresponding to these 
orders can still be used to perform the e-modifications. 

D. Final conclusion 

This approach, to approximate optimally nonadmissible 
paths of nonholomic systems, looks very efficient, and in a 
sense, universal. Of course, the theory is not complete, but the 
cases under consideration (first, 2-step bracket-generating, and 
second, two controls) correspond to many practical situations. 
But there is still a lot of work to do to in order to cover all 
interesting cases. However, the methodology to go ahead is 
rather clear. 



T(vS) be an invertible 2x2 matrix. Set z — T(w)z. It is easy 
to see that we can chose T(w) for we get: 



u + 0(e 
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y = (ywi - y^i2) 
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U2)a;, + 0(£3), 
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(y"i- 
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U2)Siw).x + 0ie'^), 







Another change of the form: w := w + L{w).x, where 
L{w).x is linear in x kills 6{'w) and brings us to w = (^"i ~ 
^M2)0(e^)- This 0{e'^) can be of the form Q^{x) + h{w)y + 
0{£^) where Qw{x) is quadratic in x. If we kill h{'w), we get 
the expected result. This is done with a change of coordinates 
of the form: w := w + (/3(w) ^. 

B. Appendix 2: Plane curves whose curvature is a function of 
the distance to the origin 

This result was known akeady, see 10). However we 
provide here a very simple proof. 

Consider a plane curve {x{t),y{t)), whose curvature is a 
function of the distance from the origin, i.e.: 



X — cos{ip), y = sm{ip), If = k{x +y). 



(23) 



VI. Appendix 



A. Appendix 1: Normal form in the 6-2 case 

We start from the general normal form (111 in normal 
coordinates: 



1 = (1 + {X2)'^^)ui - X1X2PU2, 



X^ 

±2 = (1 + {X-^)^P)U2 - XiX2(3ui, 

m = 



(ywi - yW2)7«(y,M'), 
w = (yui - -j-u2)5{y,w) 

We will make a succession of changes of parametriztion 
of the surrface S (w.r.t. which normal coordinates were 
constructed). These coordinate changes will always preserve 
tha fact that F(i) is the point x — Q,y = Q^w = t. 

Remind that ji vanishes on 5, and since x has order 1, we 
can already write on T^: x = u + 0{e^). One of the 7i's (say 
71) has to be nonzero (if not, F is tangent to A'). Then, yi 
has order 2 on T^.Set for i > 1, y, = y^ — ^. Differentiating, 



dyi 

"ST ~ 



71 



we get that 

have order 3. We set also w 

following point: 



71 



m - 77-yi + 0{e^), and zi = ^2, Z2 



2/3 

and we are at the 



x^u + 0{e'), ij = (y ui - -jU2hi{w) + O(e^), 
^i = (y "1 ~ yU2)^j(w')-a; + 0{e^), 



,X2 



Xx 



w = (y wi - yU2)(5(w).a:: + O(e^), 

where Li{w).x, 5{w).x are liner in x. The function 71 (w) can 
be put to 1 in the same way by setting y := — i^. Now let 



Equation 23 is integrable. 

Proof Set X = a;cos((/3) + ys[ii{ip), y — — xsin((/3) + 
ycos{<f). Then k{x^ + v'^) — k{x'^ + ?/^)- Just computing, one 
gets: 



dx 

~di 
dy 

dt 



l + yk(x^+i/), 
—xk{x^ + y^). 



(24) 



We just show that (24i is a hamiltonian system. Since we 



are in dimension 2, it is always Liouville-integrable. Then, we 
are looking for solutions of the system of PDE's: 



dH 

dx 
dH 

dy 



^l + yk{x^ + f), 
— —xk{x + y )■ 



But the Schwartz integrability conditions are satisfied: g-g- = 
WgM = 2*y^ • ■ 

C. Appendix 3: periodicity of the optimal curves in the 6-2 
case 

Proof We consider the nilpotent approximation Ve,2 



given in formula 15 



(7^6,2) Xi =Ui,X2=^U2,y ^ { — Ui- —U2) 



(25) 



Zl = X2[—Ui ~ —U2),Z2 = Xi{—Ui - y'"2) 

n I ^/^2 Xx 

W = Qw[Xi,X2){yU1 - y"2)- 
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We consider the particular case of the ball with a trailer 



Then, according to Lemma 16 the ratio r(^) — 1. 

It follows that the last equation can be rewritten w 



-U2) for some never vanishing 



function 6{w) (vanishing would contradict the full rank of 
A^*)). We can change the coordinate w for w such that 

We get finally: 



{^6,2) ii = ui,i2 



zi 



w 



,X2 



U2,y 
Xi 



,X2 

(y"i 

-U2),Z2 



Xi 



U2), 



(26) 



Xi 



a;i(yUl - yU2J 



X2 



{{x.r + ix2r)i-^u. 



Xi 



U2) 



This is a right invariant system on M^ with cooordinates 
^ = (Stw) = {x,y,z,w), for a certain Nilpotent Lie group 
structure over M^ (denoted by G). It is easily seen (just 
expressing right invariance) that the group law is ot the form 
i<i2,W2){'^i,wi) = (<^i * 1^2,^1 +W2 + $(^1,^2)), where * is 
the multiplication of another Lie group structure on M^ . with 
coordinates <; (denoted by Gq). In fact, G is a central extension 
of M by Go. ■ 

Lemma 27: The trajectories of (26 1 that maximize / wdt 

in fixed time e, with interpolating conditions <;(0) = i;(e) ~ 0, 
have a periodic projection on ^ (i.e. <j(t) is smooth and periodic 
of period e) . 

Remark 28: 1. Due to the invariance with respect to the w 



coordinate of ( 26 1, it is equivalent to consider the problem 
with the more restrictive terminal conditions (^(0) = <;(e) — 0, 
w(0) = 0, 

2. The scheme of this proof works also to show periodicity 
in the 4-2 and 5-2 cases. 

The idea for the proof was given to us by A. Agrachev. 
Proof: Let (<^, wi), (<r, W2) be initial and terminal points 
of an optimal solution of our problem. By right translation by 
(<r^^,0), this trajectory is mapped into another trajectory of 
the system, with initial and terminal points (0, wi +$(";, <;^^)) 
and {0,wi + $(<;,(^~^)). Hence, this trajectory has the same 

value of the cost / wdt. We see that the optimal cost is in 



fact independant of the ■^-coordinate of the initial and terminal 
condition. 

Therefore, the problem is the same as maximizing / wdt 

but with the (larger) endpoint condition <;(0) = <^(e) (free). 
Now, we can apply the general transversality conditions of 
Theorem 12.15 page 188 of [4J. It says that the initial and 
terminal co vectors (pj,p^) and (p^,p^) are such that p;t = 
p^. This is enough to show periodicity. ■ 
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